
Orientation target_orientation
CartesianTrajectoryConstraint constraint